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Abstract 

This paper considers the design of nonlinear observers for invari- 
ant systems posed on finite-dimensional connected Lie groups with 
measurements generated by a transitive group action on an associated 
homogeneous space. We consider the case where the group action has 
the opposite invariance to the system invariance and show that the 
group kinematics project to a minimal realisation of the systems ob- 
servable dynamics on the homogeneous output space. The observer de- 
sign problem is approached by designing an observer for the projected 
output dynamics and then lifting to the Lie-group. A structural de- 
composition theorem for observers of the projected system is provided 
along with characterisation of the invariance properties of the associ- 
ated observer error dynamics. We propose an observer design based 
on a gradient-like construction that leads to strong (almost) global 
convergence properties of canonical error dynamics on the homoge- 
neous output space. The observer dynamics are lifted to the group in 
a natural manner and the resulting gradient-like error dynamics of the 
observer on the Lie-group converge almost globally to the unobservable 
subgroup of the system, the stabiliser of the group action. 
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1 Introduction 



There is a growing body of work concerned with the design of nonlinear 
observers for invariant systems on Lie groups. Recent results are partly 
motivated by the need for highly robust and computationally simple state 
estimation algorithms for robotic vehicles. The classical approach to state 
estimation for such applications is based on nonlinear filtering techniques 
such as extended Kalman filters [1] or particle filters [12]. Non- linear ob- 
servers offer less information than a nonlinear filter (state-estimates rather 
than full posterior distributions for the state), however, it is often possi- 
ble to prove strong stability results with large (almost global) basins of 
attraction and provide computationally simple implementations of the ob- 
servers. Historically, work on nonlinear observers for invariant systems was 
divided into a body of applied work, closely linked to specific examples, and 
a separate body of theoretical work concerned with fundamental systems 
theory for invariant systems. One of the earliest applied results concerned 
the design of a nonlinear observer for attitude estimation of a rigid-body 
using the unit quaternion representation of the special-orthogonal Lie group 
|30| . This work is seminal to a series of papers undertaken over the last fif- 
teen years that develop nonlinear attitude observers for rigid-body dynamics 
[23[ia[22[26l[I!ll[25l^ exploiting either the unit quaternion 

group structure or the rotation matrix Lie-group structure of 50(3). Recent 
observer designs have comparable performance to state-of-the-art nonlinear 
filtering techniques [11 j . generally have much stronger global stability and 
robustness properties [20J, and are simple to implement. The full pose esti- 
mation problem has also attracted recent attention |40[ [29[ [31 [38] in which 
case the underlying state space is the special Euclidean group SE(3) com- 
prising both attitude and translation of a rigid-body. Another promising 
body of applied work involves development of heading reference systems for 
UAV systems [23, 24J. The theoretical investigation of observability and 
controllability of invariant systems on Lie-groups was first considered in the 
seventies [8] [16] [T5] in the context of the formulation of systems theory on 
Lie- groups and coset spaces. Parallel work by Sussmann investigated quo- 
tient structure of realisations of nonlinear systems and associated observabil- 
ity and controllability properties |31[ I32j . There have been only occasional 
extensions of this material since the early work, for example [101 [2j. A 
characteristic of all the work mentioned above is that authors consider only 
matched invariance assumptions on the system. That is, all the invariances 
in the system are of the same handedness; left invariant kinematics, left in- 
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variant outputs, left invariant metrics, etc. Recent work on understanding 
the generic structure of observers for left invariant systems on Lie-groups 
[3 [1^1 [20l [5] has challenged this formulation and lead to an understanding 
of the importance of invariance properties of observer error dynamics and 
the underlying properties of the observer design problem [TTJ, O [T3]. The 
present paper contains further results in this direction. 

In this paper, we consider the design of nonlinear observers for state space 
systems where the state evolves on a finite dimensional, connected Lie group 
and the measurements are generated by a transitive group action acting on 
an associated homogeneous space. We consider complementary output in- 
variance; that is, for a left invariant system we consider a right invariant 
output group action, a structure that is suggested by a body of recent work 
[SI EUJ El [18] . We show that a system with complementary outputs projects 
to a quotient system on the homogeneous output space corresponding to the 
minimal observable realisation of the full system, and consequently, that the 
stabiliser of the output group action is the unobservable subgroup of the sys- 
tem. Since the projected system is a minimal realisation of the full system 
it is natural to study the observer design problem for this system. We in- 
troduce the concept of synchrony of observer and plant [18] for projected 
systems and use this to define a "template" for observer design as a combina- 
tion of an internal model and an innovation term. The invariance properties 
of the innovation term that ensure the error dynamics of the observer / system 
couple are autonomous are also fully characterised. The second part of the 
paper introduces a constructive process for observer design based on the 
design of gradient-like innovation terms. We consider cost functions defined 
on the homogeneous output space and design a gradient-like innovation for 
the projected system. This design can be lifted to an observer on the Lie- 
group state space of the full system. Under suitable assumptions on the 
cost function we obtain (almost) global asymptotic stability of the observer 
on the homogeneous output space and corresponding asymptotic stability 
to the unobservable subgroup on the Lie-group state-space. An example on 
SO (3) is provided to demonstrate the applications of results provided in the 
body of the paper. 

After the introduction, Section [2] provides an overview of the systems consid- 
ered and notation used. Section [3] studies the structure of invariant systems 
with complementary invariance in the outputs. Section H] studies the proper- 
ties of observers for the projected system on the homogeneous output space. 
Section [5] considers the question of observer synthesis. First we consider 
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synthesis of observers for the projected system (Subsection 15. ip and then 
the lift of these observers onto the Lie-group state-space (Subsection 15, 2p . 
Section [6] provides an example based on the attitude observers that have 
been studied recently QjJJ [HI [20], [5] . A short paragraph of conclusions is 
also provided in Section 



2 Invariant systems with homogeneous output space 

In this section, we introduce the notation used throughout the paper and 
discuss some of the intuition in the models considered. 

The symbol G denotes a connected Lie group with Lie algebra q. We consider 
left invariant systems on G of the form 

X = Xu. (1) 

An input u : R — > Q is called admissible if the resulting time- variant differ- 
ential equation on the Lie group has unique solutions for all initial values. 
We assume that the velocity u is measured and can be used in the observer 
construction. The system (PQ) is termed left invariant since it is invariant 
under application of left multiplication on the group TxLyX = (YX)u 
where Ly ■ X i— > YX and Tx denotes the tangent map evaluated at X. 
An equivalent definition is used for right invariance with respect to right 
multiplication Ry '■ X i— > XY on the group. 

A smooth, connected manifold is denoted M and a Lie-group action on M 
is denoted h: G x M — > M , where the h notation anticipates that the group 
action will be acting as an output map. A group action on a manifold is 
called a right action if for all X,Y G G, y G M: h(X,h(Y,y)) = h(YX,y) 
and a left action if h(X,h(Y,y)) = h(XY,y). All actions considered in this 
paper are transitive, that is, for any x,y G M there exists X G G such that 
h(X,x) = y. 

We choose a fixed a point yo G M to be the 'reference' output. We consider 
outputs for the system ([1]) generated by the group action y = h(X,yo), 
y, yo G M. In particular, for the fixed reference yo we define h yo : G — > M, 
yo G M, and the output 

y = h yo (X) = h(X,y ). (2) 



4 



We use the terminology homogeneous output space to refer to a homoge- 
neous manifold M associated with the scenario described above. In general 
the group kinematics considered may be either left or right invariant and 
the group action can be independently either a left or right action. We 
term the case where the outputs are generated by a group action of oppo- 
site invariance to the system invariance as complementary observations. 
Conversely, we term the case where both the system and outputs have the 
same invariance as matched observations. That is, right invariant out- 
puts are complementary to left invariant group kinematics and matched with 
right invariant group kinematics, and vice versa for left invariant outputs. 

The stabiliser of an element y £ G is given by 

stab(y) = {X €G\h(X,y)=y}, 

and is a subgroup of G. We will mostly be interested in stab(yo) and assume 
that it is a closed subgroup of G. We use the notation hx '■ M —* M for the 
symmetry map 

h x (y):=h(X,y). 

While we have chosen to work explicitly with left invariant system dynamics 
on the group (PJ , the case of right invariant dynamics is analogous and all the 
results in the paper will carry through with the obvious changes. The choice 
of complementary or matched output invariance, however, is a key assump- 
tion. The main results of the paper require that the output observations 
are complementary and the results do not hold for matched observations. It 
is instructive to consider an example to provide some physical intuition for 
this choice. 



Example 1 We use the attidue estimation problem as an illustration Q [H 



attitude of a rigid body, with body-fixed-frame {B}, measured with respect to 
an inertial frame {A}, can be identified with an element R of SO {3). The 
left invariant dynamics 

R = Rfl x (3) 

on SO (3) correspond to the natural body-fixed-frame kinematics of the sys- 
tem. Here = (Qi,f22>^3) T € {B} is the angular velocity of the rigid-body 
expressed in the body-fixed-frame and 

-fi 3 ^2 

n x = | n 3 o -six 
-n 2 J)i o 



5 



Consider the case where only partial information on the rigid-body attitude 
is measured. The most common situation is when an inertial direction, such 
as the magnetic field, or gravitational field, is measured by sensor systems 
such as magnetometers or accelerometers on board a vehicle. The inertial 
direction y$ E {A} of the measured direction is known a-priori, for exam- 
ple, the gravitational direction lies in the z-axis of the inertial frame. The 
measured direction in the body-fixed-frame, 

y = R T y G {B}, 

is obtained by using the attitude matrix to transform the inertial direction 
yo from the inertial frame into the body fixed frame. The associated output 
group action that we consider is 

h:GxS 2 ^S 2 , h(R,y ) = R T y , 

a right-invariant group action. This example demonstrates the case of com- 
plementary outputs, typical for applications involving robotic vehicles where 
measurements are made by embarked sensor systems. 

An alternatively scenario involves a fixed sensor system that observes an 
autonomous vehicle in motion. An example would be a computer vision 
system that extracts a principle axis of symmetry of an observed vehicle 
from a video sequence of images. In this case the known data is a direction 
yo G {-£>} that denotes the orientation of the symmetry of the vehicle in the 
body-fixed-frame. The measurement is obtained by transforming yo into the 
inertial frame 

y = Ry £ {A}. 
The associated group action would be 

h:GxS 2 ^S 2 , h(R,y ) = Ry , 

a left-invariant group action. This second example demonstrates the case of 
matched observations. There are fewer applications where matched observa- 
tions are the natural model. 

The complementary case of a left invariant system (pQ) with right output 
action ([2]) is the case that has attracted interest recently [U [T71 EJ [18] and 
is most important for applications in robotic vehicles. It turns out, per- 
haps somewhat counter-intuitively, that the structure of invariant systems 
with complementary outputs is relatively straightforward compared to the 
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case of matched outputs. A number of recent works have shown that the 
case of complementary outputs yields autonomous error dynamics when the 
observer is properly designed [T71 El [18] and this work has lead to some 
promising applied results [231 IM|- Our work can be viewed as providing 
further perspective and extension of this research direction. The case of 
matched observations was studied in some detail in the seventies [H [161 [15] 
although observer design was not a focus of this early work. 

Remark 2 In the system ([1]) and ([2]) ; the map u i— > Xu is surjective and the 
system is fully controllable. In fact, the controllability of the system is not of 
particular interest in the main body of the paper except in the context of the 
realisation results we present. The results will hold equally well for systems 
with restricted inputs ( corresponding to limited degrees of control actuation ) 
as long as system is controllable. If the system is not controllable then the 
results presented in the paper apply to the system restricted to the maximal 
controllable subgroup. In this case the homogeneous output space considered 
must be restricted to the orbit of the maximal controllable subgroup. 

3 Structure of left invariant systems with comple- 
mentary observations 

In this section, we consider the structure of left invariant systems with com- 
plementary observations. The main result shows that there is a natural 
projection of the full system dynamics onto a system on the homogeneous 
output space that is a minimal realisation of the input-output behaviour of 
the full system, and that this in turn characterises the unobservable subspace 
on G as stab(yo)- 

In the remainder of this paper, we consider left-invariant system kinematics 
(TjTJ) and complementary right invariant 'output' group action h ([2]). Any 
system on a manifold N given globally by x = f(x,u) can be considered 
as a bundle map / : B — > TN from a trivial smooth fiber bundle B over N 
to the tangent bundle TN. In general any bundle map from a fiber bundle 
B over N to TN can be considered as a realization of a control system. 
We will use the notion of a system with symmetry |37[ [T3l [28] . A system 
/ : B — > TN with output map h: N — > M has a symmetry H (where H is a 
Lie group) if there are left actions S B : H x B — > B, S N : H x N —> N and 
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a right action S M : H x M M, such that for all X € H, v £ B, x £ M 

f(S B (X,v)) = TS$f(y), 
h(S N (X,x)) = S M (X,h(x)). 

Here denotes the map v i— > S N (X,v). 

Remark 3 iVote t/iai t/ie systems with symmetries considered in fT5l [28\j 
do not have specific output maps. The work \37$ considers symmetries for 
systems with outputs, however, the groups considered were commutative and 
the difference between left and right symmetries was lost. The definition 
we use is extended in the natural manner to conform to the structure we 
consider. The factorisation results for system with symmetries fT3\. [221 WW > 
as we will use here, have also motivated recent work on general quotient 
systems J33/ - 

Proposition 4 The stabiliser stab(yo) is a symmetry of system §Q) with 
complementary observations ([2]). 

Proof: The system (UJ and ([2]) can be regarded as a bundle map / : G x g — > 
TG via f(X,u) = Xu. Define the left actions S B (Y, (X,u)) = {YX,u) and 
S N (Y,Xu) = YXu of stab(yo) onGxg and TG. Note additionally that 
stab(yo) acts on M via S M (Y,y) = h(Y,y) = y. The symmetry condition 
on / follows trivially from the definition, while the symmetry condition on 
h follows from the definition of the stabiliser. □ 

The main structural property of the system (JTJ) with complementary obser- 
vations ([2]) is that it projects to a system on M; that is, the system on G 
maps via the group action to a system on M with trivial output map and 
this projected system is strongly equivalent to (pQ) and ([2]) in the sense of 
[32j . In other words, the system on G can be projected to a system on M 
with the same input-output behaviour. 

Theorem 5 The system (pQ) with complementary observations ([2|) projects 
to the system 

y = T x h yo (Xu), Xeh-^y) (4) 

on M. 
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Proof: Since the control system / : G x g — > TG, f(X,u) = Xu has 
the symmetry stab(yo) which acts freely and properly, it can be projected 
to a control system / on the corresponding orbit spaces [28J. As stab(yo) 
acts on G x g and TG by the corresponding left actions, we can identify 
the orbit spaces stab(yo)\G x g and stab(yo)\TG with M x g and TM 
by setting (stab(yo)X,u) = (h(X,yo),u) and stab(yo)(Xu) = Txh yo (Xu). 
The projected control system on M can be written as /: M x g — > TM, 
f(y,u) = Txh yo (Xu) for h(X,y) = j/q. Note that this shows that (|3J) is 
well-defined and smooth. The operations above can be illustrated by the 
following commutative diagram: 



Gxg 

Xu 

TG 



stab(yo)\G x 



stab(yo)\TG 



M x 



T x h y JXu)) 



TM 



Since the output map h is equivariant under the action of stab(yo) it induces 
a map h between the orbit spaces stab(yo)\G and M / /stab(yo)- As stab(yo) 
acts only trivially on M, we have that M/ stab(yo) = M. The quotient 
stab(yo)\G can be identified with M via stab(yo)-^ = h yo (X). The induced 
map h has to satisfy the commutative diagram 



G 



M 



M 



id 



M 



where idM denotes the identity. Thus h 
following commutative diagram 



idjvf. In summary we have the 



Gxg 



Xu 



T X hy (X U ) 



TG 



TM 



G 



M 



"JO 



M 



id a 



id» 



M 



M x g 

where ttg- TG — > G, 7tjw: TM — > M are the canonical projections of the 
tangent bundle. It follows from the uniqueness of solutions for admissible 
inputs that the system (JTJ) and © and the system @ with full state output 
have the same input-output behaviour. □ 

Theorem [5] provides a significant insight into the observability of the full 
system. In particular, since the system can be reduced to a fully-state 
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observable system on the observation space, the observed dynamics cannot 
provide any additional information on the system state. 

Recall that two states X, Y E G are called indistinguishable, if for any 
admissible input u the solutions X(t), Y(t) of dU) and ([2]) produce the same 
output h(X{t),y ) = h(Y(t),y ) 0132]. 

Corollary 6 Consider the system ([1]) with complementary observations ([2]). 
Two states X,Y E G are undistinguishable if and only if XY^ 1 is contained 
in the stabiliser subgroup stab(yo) of yo. In particular, a state X E G is 
undistinguishable from the identity in G if and only if X E stab(yo)- 

Proof: Since the projected system on M is fully observable, two states 
in I,Y £ G are indistinguishable if and only if they are mapped onto the 
same y E M. Two states X, Y E G are mapped onto the same y E M if and 
only if XY- 1 E stab(y ). □ 

Remark 7 One can view Theorem^ as a special case of Sussmann's result 
f32\/ of the existence of a minimal realisation. Sussmann's proof is based 
on factoring the state space by the equivalence relation of indistinguishable 
states. In our case, two states X\, X2 are indistinguishable if and only if 
XiX^ 1 E stab(yo)- Hence, factoring by this equivalence relation is equiva- 
lent to factoring by stab(yo)- This is another way to see that projecting the 
system on G onto M yields a minimal realisation of ([1]) and ([2]). 

4 Observers for projected systems on homogeneous 
spaces 

In this section we consider the structure of nonlinear observers for the pro- 
jected system on the homogeneous output space. We show that the concepts 
of synchrony and canonical errors, and a decomposition of observers into in- 
ternal model and innovation terms discussed in earlier work by the authors 
|17l [T8] can be extended to the case of complementary observations. We 
provide a full characterisation of the invariance properties of the innova- 
tion term that guarantees invariance of the error dynamics, an extension of 
recent work by Bonnabel et al. [6]. 
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Consider systems of the form 

y = T x h yo (Xu) with X G h- \y) = {X G G \ h yo (X) = y} (5) 

on the homogeneous space M. We call such systems projected systems 
since they arise from a projection of the system X = Xu on G as discussed 
in Theorem [5j A projected system, however, is defined on the homoge- 
neous space M and can be independently analysed. A simple example is 
instructive. 

Example 8 Consider Example [7] of attitude estimation on SO (3) for the 

case of a complementary observation on the homogeneous space S 2 . The 
measured output is modelled by y = R T yo for a known 'reference' yo G 
S 2 . Consider an arbitrary R y G SO (3) such that Ry~yo = y and note that 
RyUo = V = R T Uo- For any such R y the projected system dynamics are 
given by 

y = T Ry h yo (R y £l x ) = -ttxRyyo = - fL x y, 

the kinematics of an inertial direction on S 2 expressed with respect to the 
body-fixed-frame. The projected system can be studied independently as a 
kinematic system y = —^l x y on S 2 without reference to the Lie-group kine- 
matics R = Rtt x fMflfij/. 

The first concept we consider for observer structure for projected systems is 
that of synchrony of a plant and an observer. We use the notation e: M x 
M — > N, to denote a smooth error function function to a smooth manifold 
N. An error function is a generalisation of the observer error (x — x) that is 
used for systems on M. n . For the moment we make no further assumptions 
on the error function. 

Definition 9 Let M be a smooth manifold, B a vector bundle over M , 
f x : B — > TM , f%: B — > TM bundle maps and 

x =f x (u) (g) 

x =fx{u) 

a pair of general systems on M . We call the pair of systems ([6]) e-synchronous 

with respect to an error function e: M x M — > if for all admissible 
u: 1R — > M n , all initial values xq, xq G M, and all t G M + 

^-e(x(t; x ,u),x(t; x ,u)) = 0. 
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Theorem 10 Consider a pair of projected systems on M, 

x = T x h yo (Xu), Xeh-^x) 

% = T x h yo( Xu ) > X^Ko^- 

If there exists a smooth error function e : M x M —* N such that the systems 
are e- synchronous, then e has the form 

e(x,x) = g(h yo (X X~ 1 )) with h yo (X) = x,h yo (X) =x 

and g: M — > N a smooth function. 



Proof: We first show that e has to be invariant under the action of G 
on M x M, i.e. e(h(S , x) , h(S , x)) = e(x,x) for all x,x G M, S G G. Let 
5gG and xq,xq G M. We choose a smooth curve T: [0, 1] — > G, T(0) = e, 
T(l) = S 1 and set u(i) = T(t)- l T(t). Note that for any x G M, i G [0, 1], 
R G with yo) = x we have 

jh{T(t),x) = j t h(T(t),h(R, yo )) 



-h yo (RT(t)) 



d_ 

T RT(t)hy (RT(t)) 

T RT{t) h yo (RT(t)u(t)). 



Hence h(T(t),x) is a solution of i; = Txh yo (Xu), X G h~^(x) with ini- 
tial value x and it(t) = T(t) T(t). Thus (h(T(t),xo),h(T(t),xo)) is the 
solution of (J7|) with inital value (xq,xo) and u(i) as above. Since the sys- 
tems are e-synchronous, e is constant on solutions of ([7]) and e(xo,Xo) = 
e(h(T(l),x ),h(T(l),x )). Thus for all S G G 

e = e o hs 

and e is invariant under the action of G. For x, x G M let now X, X G G 
such that h yo (X) = x, h yo (X) = x. Then 

e(£, x) = e(h(X, y ), h(X, y )) = e(h(X-\h(X, y )),y ) = e(h yo (ir 1 ),^) 

Thus e has indeed the form as claimed in the theorem with a smooth g: M — > 
i\r,s(*) = e(3,j/b). □ 
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Theorem [18] justifies the consideration of a canonical error function 

e(x, x) = h{XX~ l , yo) with h yo (X) = x, h yo (X) = x. (8) 

The canonical error function is well-defined, smooth and non-degenerate, in 
the sense that the differential of e with respect to either the first or second 
variables is full rank. Note that "no error" corresponds to e(x,x) = yo. 



Remark 11 The canonical error is the projection of the right-invariant er- 
ror considered in the Lie group case ]18$ onto the homogeneous space M . The 
right- invariant error was associated with synchrony of left- invariant systems 
on the Lie group. 



Definition 12 Two systems on a homogenous space are synchronous, if 

they are e-synchronous with respect to the canonical error (jSJ). 



Theorem 13 Consider the projected system ^ on a homogeneous space 
M , and a general second system on M of the form 

y = fy{y,u,t). 

Then the pair of systems are synchronous if and only if 

fy(y,u,t) = T^h yo (Xu), 
for all X € G such that h(X,yo) = y. 



Proof: Consider firstly a pair of systems 

y=T x h yo (Xu) (9a) 

y=T A h yo (Xu). (9b) 

Consider the systems on G 

X=Xu, h(X(0),y )=y(0) (10a) 

X=Xu, h(X(0),y ) = y(0). (10b) 



It is straightforward to see that the solutions of (|T0|) project to the solu- 
tions of ([9]). From the Lie group case [18], it is known that the systems 
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(jlOP are synchronous with respect to the right invariant error E r = XX^ 1 . 
Hence their projected solutions ([9]) must be synchronous with respect to the 
projection of E r , the canonical error on M. It follows that the plants are 
synchronous. 

On the other hand, consider a pair of synchronous systems 

y = T x h yo (Xu) 

y = fy(y,u,t). 

Consider the system (jlOap along with 

x = (fy(y,u,t)) H , 

where v H denotes^ the horizontal lift with respect to an arbitrary, smooth 
horizontal distribution to the fibres of M in G. For the right invariant error 
on G, one has 

j f XX- 1 = T x R x -i (f y (y,u,t)) H -T x -iL x T e L x -xT x R x -iXu 
= T x R x-i (fy(y, u, t)) H - T x R x -iT e L x u. 

Since these systems project down onto the original systems on M, the equiv- 
ariance of h yo yields that 

^h yo {XX- x ) = T xx _ x h yo T x R x -x (f y (y,u,t)) H -T xx ^h yo T x R x -xXu 

= Tyh x ~iT x h yo (f y (y,u,t)) H - Tyh x -iT x h yo Xu 
= T y h x -if y (y,u,t) - T y h x -iT x h yo Xu. 

Since this result holds for all initial values y(0) £ M, the synchrony condition 
of the systems yield 

fy(y,u,t) = T x h yo (Xu). 

□ 

From the definition of synchrony it is possible to develop and decomposi- 
tion of an observer into a synchronous internal model and an innovation or 
nonlinear output injection term. 

A construction of a suitable horizontal distribution is given in the proof of Theorem ll6l 
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Definition 14 Consider a pair of systems f y : 6xl-> TM , fy\ B x M x 
R -> TM, 

y = .A/ CM) 
y = fy(w,y,t) 

on a homogeneous space. 

1. We say that y has an internal model of y if for all admissible inputs, 
all y G M and all t G E + 

y(t, yo,y(t, yo, u),u) = y(t, y ,u) 

2. We define an innovation term to be a map a: M x TM x M — ► TM 
(aj a(y,w,y,t) G T^M 

W a (.y( t ,yo,y{t,yo,u),u),fy(u,t),y(t,y ,u),t) = /or a// y G 
i G R and a// admissible inputs u. 

Proposition 15 Consider the projected system ([5]) on M. T/ien any ob- 
server with an internal model of this system has the form 

y = T^h yo (Xu) + a(y,u,y,t) (11) 

where a is an innovation term. 

Proof: Consider an observer 

y = f(y,u,y,t) 

with an internal model of the observed system. Then we can define 

g(y,u,y,t) = f(y,u,y,t) - T x h yo (Xu). 
A calculation analogous to the proof of Theorem [13] shows that 

—h yo (XX- 1 ) = Txx^hyoTxRx-igtyMyyt). 
Since y has an internal model of y, this implies that 

g(y,u,y,t) = 
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for all y £ M, t £ M. and admissible u £ g, i.e. 5 is an innovation. □ 

We call an innovation term a: M x q x M x K — > TM equivariant if for 

all 5 £ G, y, y £ M, u £ g, i £ R 

Tyh s a(y, u, y, t) = a(h s {y),u, h s (y),t). 

Note that in this definition we consider only the specific action (S 1 , y, u) 1— > 
(hs(y),u) on the control bundle B = Mxg, 



Theorem 16 XYie dynamics of the canonical error of an observer with an 
internal model, (jlip , is autonomous if and only if the innovation term a is 
equivariant and does not depend on u or t. The autonomous error dynamics 
has the form 

—e = a(e,y ). 



Proof: Choose a subspace h C g such that g = kevT e h yo + f) is the 
direct sum of Ij and the Lie-algebra of the stabiliser subgroup. Define a 
horizontal distribution H on G by H(X) := T e Rxfy- Let u: R — > g be a fixed, 
admissible input and y(t), y{t) two solutions of © and (fTT]) corresponding to 
this input. We choose Xq,X$ £ G such that h yo (Xo) = y(0) and h yo (Xo) = 
y(0). Let and be curves with initial values Xq, Xq, which satisfy 
the differential equations 

X = Xu 

X = Xu - (a(y,u,y,t)) H , 



where (v) denotes the horizontal lift of a vector v £ T^p^M to TxG 
via H(X). The curves project to y(t) and y(t), i.e. h yo (X(t)) = y(t) and 
h yo (X(t)) = y(t) hold. Let us first consider the right-invariant error XX^ 1 
on the Lie group. Then we get that 

111" 1 
dt 

= T^Rx-iXu + T^Rx-i (a(y, u, y, t)) H - Tx-iL^TeLx-iTxRx-iXu 
= Tj^Rx-i (a{y,u,y,t)) H 
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Using the equivariance of the canonical projection we get for the canonical 
error on the group that 

7^ e = T xx-i h yo( T x R x-i(a{y,u,y,t)) H ^ 

= T § h x -iT x h yQ ((af(y,u,y,t)) H ^J 
= T y h x -ia(y,u,y,t). 
If a is equivariant and does not depend on u or t, then 

-^e = a(h(X~ 1 ,y),y ) = a(e,y ), 

i.e. the dynamics of e is autonomous. On the other hand, if the dynamics 
of e is autonomous, then there is a function F: M — > TM with for all 

e,y,y G M X,X G G with h yo {X) = y, h yo (X) = y, h yo (XX' r ) = e, that 

F(e) = Tyh x -ia(y,u,y,t). 

It follows immediately that a does not depend on u or t, i.e. a(y,u,y,t) = 
a(y,y). Since the canonical error is invariant under the natural action of G 
on M x M, one has for all S G G that 

T h s {y)h(SX)-m{hs{y),h s {y)) = F(e) = T y h x -ia(y,y). 

In particular, this holds for y = y . Thus, for all S G G, y G M 

T y h s a(y,y ) = a(h s (y),h s (yo)). 

For x,y G M, R G G with y = h(Y,yo), we can set y = h(Y~ 1 ,x) and 
5 = RY, and obtain 

T y h R a(x,y) = a(h R (x),h R (y)). 
Hence a is equivariant. □ 

5 Observer synthesis 

In this section we consider the question of observer synthesis. The approach 
taken is to build observers from a synchronous term along with an gradient- 
like innovation derived from a cost function on the homogeneous space. 
Thus, we begin by considering gradient-like observers for projected systems 
and then look at lifting these observers up to the Lie group. 
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5.1 Observer synthesis on the projected system 

In order to compute gradient-like terms for construction of the observer it is 
necessary to define a Riemannian metric on the homogeneous output space. 
Furthermore, it is natural, and indeed necessary for the results that follow, 
that the metric is invariant with respect to the group action. Not all homo- 
geneous spaces necessarily admit such a metric and it is necessary to assume 
this additional structure to continue with the proposed approach. That is, 
we assume that the homogeneous output space M is a reductive homoge- 
neous space, or equivalently that it admits an invariant Riemannian metric 
(•, •) on M t9j. One has that for all S G G, y G M, u, v G T y M 

(u,v) = {Tyh s u,Tyh s v). 

Let / : M x M ^ R be a smooth cost function on M. That is, the diagonal 
A = {(y,y) | y G M} is a closed minimal level set of the function /. A 
smooth cost function / : M x M — > M is said to be invariant function with 
respect to the group action h if 

f(h(S,y),h(S,y)) = f(y,y) 

for all y,yeM,Se G. 

We propose the observer design 

y = T^h yo (Xu)-grad 1 f(y,y) (12) 

for the system © on M. Here, grad x / denotes the gradient of the function 
y i — > f(y, y). Note that since / is minimal on the diagonal A then y \— * f(y, y) 
has a local minima at y = y and grad 1 f(y,y) = 0. This shows that the 
gradient term is an innovation according to Definition [T4l The following 
lemma shows that the innovation gradj^ / is itself equivariant if the cost 
function and metric are invariant. 

Lemma 17 Consider a group action h : G x M — > M on a reductive homo- 
geneous space M . Let g be an invariant metric on M and f be an invariant 
cost function with respect to h. Then for all S G G, y,y G M 

grad x f(h(S,y),h(S,y)) = T y h s grad x f(y,y). 

That is gradx / is an equivariant vector field on M . 
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Proof: By the invariance of / and the Riemannian metric we have for all 
v € T % M 

(grac^ f(y,y),v) = dxf(y,y)(v) 

= dufihfaylhftyMTthsiv)) 
= (g^d, f(h(S,y),h(S,y)),T ij h s (v)) 

= ((TyhsV 1 gradx f(h(S,y),h(S,y)),v\ , 

with di denoting the differential with respect to the first variable. □ 

Since any equi variant innovation term yields autonomous error dynamics 
(Theorem I16p . we obtain the following corollary for the proposed gradient- 
like observer (|12p . 

Theorem 18 Consider system ([5|) on a reductive homogeneous space equipped 
with an invariant metric. Assume that there is an invariant cost function f 
and consider the observer (|12p . Then the canonical error e = h{XX~ x ,yo) 
has the dynamics 

e = -grad x f(e,y ). 

Proof: By Lemma [T71 the term grad 1 / is equivariant. By Theorem ()16|) 
the error is autonomous and the the form as given above. □ 

Since the projected system is fully observed and the observer design is based 
on a gradient construction, it is possible to obtain strong almost global 
stability results for the observer. 

Corollary 19 Consider system ^ on a reductive homogeneous space equipped 
with an invariant metric. Assume that there is an invariant cost function 
f and consider the observer ()12p . Assume furthermore that y i— > f(y,yo) is 
a Morse-Bott function with unique global minimum yo o- n d no further local 
minima. Then the error e converges to yo for almost all initial conditions 
and arbitrary, admissible inputs u. 

It is relevant to note that although the innovation term is equivariant the 
observer itself is not. This is due to the fact that the synchronous term is not 
equivariant with respect to direct to direct application of the group action. 
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This situation is analogous to the case observed for Lie group systems with 
full measurements |18j . 



Since the system state of the projected system is fully observed then the 
choice of a gradient innovation term based on a function of the full state on 
M is very natural. The most significant difficulty in the proposed observer 
design is the requirement to find a suitable cost function /. The two require- 
ments for a cost function candidate are the invariance property (used in the 
structure of the observer design) and the Morse-Bott requirement (used in 
the convergence proof Corollary [T9l) . The easiest approach to generating 
cost functions is to start by searching for a Morse-Bott function candidate 
without demanding the invariance property. That is one looks to construct a 
function / : M — > R such that f(y) is Morse-Bott and has an isolated global 
minima at yo. Such a function is always locally available by considering 
a least squares cost with respect to local coordinates on the homogeneous 
output space M. In practice, local coordinates generally yield a poor choice 
and the best Morse-Bott function candidates are obtained by studying the 
global geometric structure of the homogeneous space case by case. Since 
such homogeneous spaces are generated as symmetry spaces of Lie groups 
there is often significant structure that can be exploited in the construction 
of global Morse-Bott candidate functions. Once such a function / is found 
it can be used to generate an invariant cost function by setting 



forward to verify that / is well defined and invariant. Moreover, if / has an 
unique global minimum at yo and no further local minima, the function / 
will satisfy the conditions of Corollary 1191 The construction is analogous to 
the development given in [T5] . 




5.2 Observers for the full system 

Section 15.11 provided a constructive process for the design of observers for 
projected systems. Since the projected system has a fully observed state, 
the gradient based innovation is one of the most natural approaches to ob- 
server design. Since the projected system is a minimal observable realisa- 
tion of the (H]) and (|2|) on the Lie group, it is not to be expected that an 
observer constructed separately on the Lie group could yield more informa- 
tion about the state than that obtained from the projected system. Thus, 
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the most 'natural' observer on the Lie group is the 'lift' of the observer on 
the projected system onto the Lie group. However, only the innovation is 
equivariant for the project system observer and the main system cannot be 
unique lifted. The proposed solution is to lift the innovation and use the 
natural synchronous internal model on the Lie group to define an observer. 

For any reductive homogeneous space there is an invariant horizontal distri- 
bution H{X) and an invariant Riemannian metric on G such that the pro- 
jection of the metric from H(X) onto TM induces the invariant Riemannian 
metric on M. Details of the construction for the case of left invariant actions 
is provided in Cheeger et al. [9j. The case of right group actions and right 
invariant metrics is entirely analogous. The horizontal distributions arising 
in this construction have the form discussed in the proof of Theorem [TBI 
but the subspace rj has to be chosen to satisfy some additional constraints 
that ensure the metric construction is well defined. Given the horizontal 
distribution H{X) there is a unique linear map, termed the lift, 



: T y M -> H(X) 

such that T x h yo ((v) H W) = v. That is (v) H ^ G H(X) denotes the lift of 



v € T y M. Where the point X G G is clear from context, or any choice is 
equivalent, we will write (y) H = (v) H ^ x \ 

The proposed observer for the system (JTJ and ((2J) is given by 



on the group. The following proposition follows directly from its construc- 
tion. 

Proposition 20 The observer ([13]) projects to the observer ([12"]) on the 

homogeneous space. 

Only the innovation term is a horizontal lift in (|13|) . The full system is not 
a horizontal lift since Xu H(X) need not lie in the horizontal distribution 
and consequently 



The proposed observer, however, can be thought of as a more general lift 
of projected system onto G as shown in Proposition [20J. The convergence 
properties of the observer (|13p follow directly from the results on the homo- 
geneous space. 




(13) 



Xu^(T t h yo {Xu)) 



H 
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Corollary 21 Consider the left invariant system (Q]) with complementary 
outputs J2} on a reductive homogeneous output space. Let f be and invariant 
cost function such that y t— > f(y, yo) is a Morse-Bott function with unique 
global minimum yo and no further local minima. Let E r : G x G — > G, 
E r (X,X) = XX^ 1 be the right invariant error on G /-?£]/ • 

Then for generic initial conditions X(0) and arbitrary, admissible inputs u 
the error E r converges asymptotically to stab(yo)- 

Proof: This result is a straightforward consequence of Corollary [19] and 
the fact that the canonical error on M is the projection of E r . □ 

The observer (|13p can also be derived directly on the Lie group. For this 
purpose we define the lift / of the cost function / as the map G x G — > R, 

f(X,X) = f(h yo (X),h yo (X)). (14) 

Proposition 22 Consider a right group action on a reductive homogeneous 
space. Let f : M x M — > K be an invariant cost function on M and let f be 
given by (fT4"j) . The gradient of the cost function f and the lifted function f 
are related by 

gradi = (grad 1 /(^ (X),/ l , (X))) H , 

If f is invariant under the action of G on M , then the lifted function f is a 
right invariant cost function on G. 

Proof: For the first statement, note that for all v £ T-^G 

d 1 f{jt,X)(v) = dif{Xy Q ,Xy Q )(Tj t h Vo v). 
Hence for all v € Tj>G 

(grad x f(X,X),v) = (grad x f(Xy , Xy Q ), T^h yo v). 
In particular, 

(gr a dJ(X,X),v) =0 

for v E kerT-£rh yo . Hence, grad 1 /(X,X) € H{X). On the other hand we 
have by our conditions on the Riemannian metrics that for all v £ H(X) 

(gradi f(X, X),v) = (Tj^hy, gr^ f(X, X),Tgh yo v). 
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Hence grad x / is the horizontal lift of grac^ /. If / is invariant, then for all 
X,X ,Z £ G we have 

f(XZ,XZ) = f(h yo (XZ),h yo (XZ)) = f(h(Z,h yo (X)),h(Z,h yo (X))) 

= f(h yo (X),h Vo (X)) = f(X,X), 

i.e. the lift is invariant too. □ 

The lifted cost function is then a candidate for the observer construction 
for systems on a Lie group proposed in earlier work |18j . This construction 
yields 

X = Xu-®:ad l f{X,X). (15) 

This construction is made based on the understanding that the full state 
X is measured, however, in this specific case the state X is only used in 
the innovation term in a manner that can be derived from the information 
contained in the measurement y = h(X, yo). The easiest way to see this is to 
note that by Proposition [22] the observer ()15|) is the same observer as ()13|) . 
As a consequence we get the equivalence of the observer error trajectories. 

Corollary 23 Consider the left invariant system ([!]) with complementary 
outputs ([2]) on a reductive homogeneous output space M. Let f be and 
invariant cost function such that y \— > f(y,yo) is a Morse-Bott function with 
unique global minimum yo and no further local minima. Let E r = XX^ 1 be 
the right invariant error on G and e = h(E r ,yo) be the induced canonical 
error on M . Then ifh(X(0), yo) = 2/(0), the error trajectory E r (t) generated 
by (|13p with initial conditions X(0) on G projects to the error trajectory e(t) 
generated by EH with initial conditions y(0). That is 

h{E r {t),y ) = e(t). 

6 Example: Attitude estimation 

In this section, we complete the analysis of the simple example introduced 
in Examples [1] and [8] to demonstrate how the developments in the paper 
can be applied in practice. We consider the complementary output case 
discussed in Example [fl that of estimating the attitude of a rigid body based 
on measurements of a single vectorial direction measured in the body-fixed- 
frame along with full measurement of angular velocity. There is an extensive 
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literature concerning the estimation of attitude of rigid-bodies based on 
body-fixed frame measurements 0lElEl[ZliniIIliniIIBlIISll2Qll22l|3Il|211 
[23l[25l[Ml[3Ql[35l[Ml[Ml[39l[in]- We mention in particular, the recent papers 
|144 [20] that introduced the "explicit complementary filter" and the earlier 
work [261 |2"5] that developed observers for an inertial direction. Both these 
observers are obtained as specialisations of the general techniques proposed 
in this paper for a natural choice of cost function. We mention also the 
independent work [5l[6] that obtained the same observer as [20] . 

The system is posed on SO (3) (see Example HJ 

R =Rn x (16a) 

y =R T yo (16b) 

with j/o € {^4} the 'reference' direction in the inertial frame. The comple- 
mentary output y € {B} is the observed orientation of the vectorial direction 
measured in the body-fixed-frame. The measurement equation (j!6b|) mod- 
els the coordinate transformation induced by the relative orientation of {B} 
with respect to {A}. 

The homogeneous output space is the unit sphere S 2 . By Theorem [5l the 
system (|16|) projects to a system on S 2 . Recalling the derivation in Exam- 
ple [8] the projected system can be written 

y = -n x y, y(0) = h(X(0),y ) (17) 

on S 2 . We continue by designing an observer for system (|17|) as discussed 
in Section O 

Consider the cost function f(y,y) = (k/2)\\y — y\\ 2 for k > a positive 
constant. It is straightforward to verify that / satisfies the conditions of 
Corollary 1191 That is, /: S 2 x S 2 — > R is invariant under the right action of 
SO (3) on S 2 x S 2 , and / is Morse-Bott in the first argument with a unique 
global minima at y = y. The constant k is introduced to provide a tunable 
gain in the observer design: adjusting k scales the eigenvalues of the Hessian 
of / and tunes the exponential rate of the convergence of the error dynamics. 
Note that 

k 

f(y,y) = -j\\y - y\\ 2 = H 1 - (y,v))- 

The term (1 — (y,y)) = 1 — cos(Z(y,y)) is locally quadratic in the angle 
Z(y,y)). The references [26j [251 O I2Q] used (1 — {y,y)) directly as a Lya- 
punov function. This cost is also closely related to the quaternion cost used 
in earlier works (301 E6] as discussed in the appendix of [20] . 
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The Riemannian metric on S 2 induced by the direct embedding of S 2 in M 3 is 
invariant under the right action (R, x) i— > R T x of 50(3) on IR 3 . In particular, 
(R T v) T R T w = v T RR T w = v T w for v,w e T y S 2 C M 3 . The gradient 
of / is computed from the relationships (grad 1 f(y, y), w) = d\ f(y, y)[w] 
and grad x f(y,y) G T^S 2 . Here di f(y,y) denotes the differential of / with 
respect to the first variable, i.e. y. One has 

di f(y,y)[w] =w T (y -y) = kw T (I - yy T ){y - y) 

" v ' 

since w T = w T (I — yy T ) as w G T^S 2 . It follows that 

grad x f(y, y) = -k (i - yy T ^j y 

since y is in the kernel of the projection (/ — yy T ). 

The proposed observer for the projected output system is (fT2|) 

y = -n x y + k(I -yy T )y. (18) 

Note that this observer equation is fully posed as a system on S 2 and does 
not depend on the underlying system on 50(3). Since y i— > f(y,y) is a 
Morse function with only one global minimum and no further local minima, 
Corollary 1 1 9 1 applies and the canonical error on 5 2 for this observer converges 
for generic initial conditions to yo- 

It is of interest to provide an equivalent form for Eq. [THJ Observe that 

Hyy T - yy T )y = Kv ~ W T y) = k(l- yy T ^J y = - grad x f(y, y) (19) 
Moreover, it is easily verified that 

(yy T -yy T ) = (yxy)x (20) 

Thus, (fT8|) can be written 

y = -fl x y + k(yxy)xy. (21) 

This observer was originally studied by Metni et al. [26, 25]. The derivation 
given in earlier work is based on a Lyapunov analysis and includes an integral 
term for compensation of gyro bias that does not fit the analysis framework 
presented in this paper, however, the main proportional terms in |26|, [25] 
are exactly (|2ip. 
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To lift (|18p to SO (3) it is necessary to construct a right invariant horizontal 
distribution for which the right invariant metric on SO(3) projects to the 
metric (u, v) on S 2 via the differential of the group action. Define 

f) = {^x G | tr(wJ(|/o)x) = 0} = {w x \ u G M 3 ,cj T y = 0} 

The subspace f) is chosen as the orthogonal complement of the subalgebra 
of the stabiliser of h under the inner product (f2 x , ty x ) = tr^^^x) defined 
on q. Physically, this set corresponds to angular velocities expressed in the 
inertial frame {^4} that are orthogonal to the reference direction uq. The 
horizontal distribution H(R) is defined in the standard manneiH 

H(R) = {u; x R\uj x G f)}. 

For any uj x G f) there is an element Q x = Ad^ T u> x , where Ad^ T <u x = 
R t uj x R is the adjoint operator, associated with the angular velocity u ex- 
pressed in the body-fixed-frame. Thus, one can also write 

H(R) = {Rtt x | n x = Ad^x w x ,u; x G h}. 

Next we consider how to compute the lift (v) H of a tangent vector in TyS 2 
into H(R). Let w G T^S 12 and R G ,SO(3) such that h(R,yo) = y. Define 
Cl(v ) by the solution to 

n(v) xy = v, Cl(v) T y = 0. 

Since v G I^S 12 is orthogonal to y then it is clear that this vector exists and 
is unique. Physically, fl(v) is the instantaneous body- fixed- frame velocity 
that generates the observed velocity v for the projected dynamics of y, and 
has zero yaw component around y. The horizontal lift (v) H is defined by 

(v) H := {Ad A n(v) x )R = m(v) x . 

The element co(v) x = Adp,Q(v) x G fj corresponds to the element in the 
subspace f) representing the lifted angular velocity expressed in the inertial 
frame. 

It remains to show that the metric (u, v) = u T v on S 2 is induced by a right 
invariant metric on H(R). Observe that for v, w G T y S 2 then for any R such 

2 See also the proof of Theorem 1161 
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that h(R, yo) = y, one has 

V T W =y J n(v) x tt(w) x y = n(v) T y x y x Cl(w) 
=n(v) T (I - yy T )n(w) = Cl(v) T n(w) 

=itr(n(t;)JnH x ) =±(si(v) x R,n(u) x R) (22) 

where the final line is the natural right invariant metric on the Lie group 
SO (3) scaled by 1/2. The scaling factor is associated to the structure of the 
matrix representation used. The above argument verifies that the projection 
Tj^h yo projects the right invariant metric (f22j) restricted to H(R) to the 
embedded Euclidean metric on T-gS 2 . 

From Equation [13] the lift of the observer Q15|) is 

k = m x + k([I-yy T )y) H (23) 

From Proposition [20] it follows that this observer projects to the observer 
on S 2 , Eq. [18] Corollary [21] states that R converges to the set {R G 
50(3) | h(R,y ) = y}, that is, R is identified up to the unobservable ro- 
tation around the measured direction. 

It is of interest to provide an explicit form for Eq. [23] Recalling (|19j) and 
([2"P]) one has 

gra^ f(y,y) = k{y x y) x y 

It is easily verified that ^(gra^ f) x = k(y x y) x . Thus, the lifted observer 
can be written 

A^u-kiAd^y xy) x )R 

=R(u-k(yxy) x )=R(u + k(yxy) x ) (24) 

Equation [M] is the explicit complementary filter proposed in [20, Eq. (32)] 
excluding the integral introduced in that paper to compensate gyro bias. 

The observer (I23h can also be obtained as a direct gradient of a lifted cost 
function. The lifted cost function / of / is given by 

f(R,R) = ^\\R T y - R T yo\\ 2 = ~ tr ((£ -R)(R- R) T y yj) . 

The differential of the lifted cost function with respect to the first coordinate 
is 

di f(R, R)[m x ] = fctr (EO x (E - R) T y yj) -kit ({R - R)n x R T y yj) 
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Rearranging terms and using the notation P so (3) (A) = (A — A )/2 for matrix 
projection onto the subspace of anti-symmetric matrices, the differential can 
be rewritten 

di/(R,i?)(ffl x ) =ktv (n x F B0(3) ((R-R) T y yjR)) 

=2ktv(n x F S0{3) ((y-y)y T )) 
=2A:tr (n x (yy T - yy T )) . 

Using the metric (|22p one obtains the gradient 

grad x f(R,R) = -kR(yy T - yy T ) = -kR(y x y). 

Note that factor of 1/2 in the metric cancels the factor of 2 in the differential. 
The gradient-like observer on the Lie-group is 

R = Ru- kR(y x y) = Ru - (gradi f(R, R)) H 

(recalling ([2Tj) l and one obtains the observer (plj) as expected. 

7 Conclusions 

This paper provides a comprehensive analysis of the design of observers for 
invariant systems posed on finite-dimensional connected Lie groups with 
measurements generated by a complementary group action on an associated 
homogeneous space. The observer synthesis problem can be tackled for the 
projected system on the homogeneous output space based on a canonical de- 
composition of the observer dynamics into a synchronous internal model and 
an equivariant innovation. A gradient-like construction for the innovation 
term was proposed that leads to strong stability properties of the observer, 
both for the projected system on the homogeneous output space, and for 
the lifted system on the Lie-group (stable to the unobservable subgroup). 
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